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© METHOD OF CONTROLLING ACCELERATION AND DECELERATION. 

(57) A method of generating a speed command signal which 
is delivered to a servo motor control unit in a position control 
apparatus. A given position command signal is applied to a 
low-pass filter (4) either directly or through a linear accelera- 
tion/deceleration unit (3). An output of the low-pass filter (4) 
is employed as a speed command signal delivered to a 
control unit (6) for a servo motor (M). 
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SPECIFICATION 
ACCELERATION /DECELERATION CONTROL SYSTEM 
Technical Field 

The present invention relates to an 
acceleration/deceleration control system of a servo 
motor used in an NC machine tool and a robot. 
Background Art 

Fig. 1 is a block diagram of a servo motor 
acceleration/deceleration control system. A typical 
example of the conventional acceleration/deceleration 
system of this type is an exponential accelera- 
tion/deceleration control system. 

In this system, an exponential function type 
acceleration/deceleration control unit is used as an 
acceleration/deceleration control section 1 shown in 
Fig. 1. When a position instruction is supplied as a 
displacement V Q per unit time to the accelera- 
tion/deceleration section 1, i.e., when a pulsed input 
shown in Fig. 2(a) is entered as a value V Q which is 
substantially the same as the velocity, an exponential 
output shown in Fig. 2(b) is obtained. 

As shown in this response waveform, an 
acceleration speed is high at a leading edge (indicated 
by a in Fig. 2) due to the influence of a 
high-frequency component, so that a servo control 
section 2 and a load system are subjected to shock, 
resulting in vibrations. As shown in Fig. 2(b), a long 
period of time is required to decelerate and stop the 
servo motor, resulting in inconvenience. For these 
reasons, for example, when X- and Y-axis servo motors 
are used to shift a table of a machine tool in an 
arcuated manner, the table has a locus smaller than 
that designated by an instruction. 

A linear acceleration/deceleration control system 
can be used in place of the exponential accelera- 
tion/deceleration control system. An output waveform 
shown in Fig. 5(b) is obtained in response to a step 
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input shown in Fig. 5(a). As indicated by this output 
waveform, an acceleration speed abruptly changes, and a 
servo control system and a load system are subjected to 
shock, resulting in vibrations. For example, an arm of 
5 a robot or the like continues to vibrate when it is 
stopped quickly , resulting in inconvenience. 

Furthermore , since the servo control system and 
the load system have natural frequencies, when the 
servo control system and the load system are driven by 

10 frequency components similar to the natural 

frequencies, respectively, the servo control system and 
the load system vibrate by themselves. For this 
reason, vibration of the natural frequency components 
included in position instruction for. the servo control 

15 system and the load system must be cut off. 
Disclosure of Invention 

A transfer function in an exponential accelera- 
tion/deceleration control section for generating the 
output shown in Fig. 2(b) in response to the step input 

20 shown in Fig. 2(a) is a transfer function H(S) having a 
time-lag of first order as follows: 

H(S) « K/(S + K) ... (1) 

where K is a constant. 

This transfer function is obtained by a 

25 first-order low-pass filter. The conventional 

.acceleration/deceleration control section 1 given by 
this transfer function indicates that a low- frequency 
component included in the position instruction (input) 
passes through but a high-frequency component is cut 

30 off, and that the resultant frequency component as the 
position instruction is supplied to the servo control 
section 2 . However , as indicated by the output 
waveform shown in Fig. 2(b), the influence of a 
high-frequency component occurs at the leading edge or 

35 the like to cause an abrupt change in velocity. For 
this reason, in order to cut off the high-frequency 
component, a time constant of the transfer function 
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given by equation (1) must be increased • However , when 
the time constant is increased, a response time becomes 
slow, and a time for stopping the servo motor becomes 
prolonged. 

5 This can be overcome by using a higher-order 

low-pass filter in place of the first-order low-pass 
filter. In this case, the position instruction to the 
servo motor is filtered through this higher-order 
low-pass filter, and the servo motor is driven by the 
10 filtered component. As the low pass filter has a 
higher order, the natural frequencies of the servo 
control system and the load system can be cut off, and 
the high-frequency component is also cut off. As a 
result, a smooth response waveform and a fast response 
15 can be obtained. 

It is, therefore, a first object of the present 
invention to provide an acceleration/ deceleration 
control system of a servo motor, wherein a change in 
velocity can be decreased by using a higher-order 
20 low-pass filter, and a short response time can be 
obtained with a small delay. 

It is a second object of the present invention to 
provide an acceleration/deceleration system of a servo 
motor wherein no vibrations occur and the servo motor 
25 can be operated with a small change in velocity* 
In order to achieve the above objects of the 
present invention, there is provided an accelera- 
tion/deceleration system for controlling accelera- 
tion/deceleration of a servo motor by filtering a 
30 position instruction to the servo motor through a 
low-pass filter of second or higher order. 

According to the acceleration/deceleration control 
system for controlling^ linear acceleration/decelera- 
tion, the position instruction supplied to the servo 
35 motor is subjected to linear acceleration/deceleration 
control* The linearly controlled instruction is 
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filtered through a low-pass filter of second or higher 
order. 

As described above, since the position instruction 
is supplied to the servo motor through the low-pass 
5 filter of second or higher order, the high-frequency 
component is cut off, and the natural frequency 
components of the servo control system and the load 
system are also cut off • As a result, the servo 
control system and the load system will neither be 
subjected to shock nor generate vibrations. In 
addition, the servo control system and the load system 
will not vibrate by themselves* Since a high-order 
low-pass filter is used, a fast response time can be 
obtained. For example, unlike the conventional 

15 example, a table or the like of a machine tool will not 
trace a locus smaller than that specified by the 
instruction even if it is driven in an arcuated locus. 
Brief Description of Drawings 

Fig. 1 is a block diagram of an acceleration/de- 

20 celeration control system of a servo motor. Fig. 2 

shows waveforms of an input and an output with respect 
to a conventional exponential acceleration/deceleration 
control system, Fig. 3 shows input /output waveforms 
with respect to the acceleration/deceleration control 

25 section when a higher-order low-pass filter is used in 
this section, Fig. 4 is a block diagram of an 
embodiment of the present invention when a higher-order 
low-pass filter is used, Fig. 5 shows input /output 
waveforms of the respective blocks of the embodiment 

30 shown in Fig. 4, Fig. 6 is a block diagram of a linear 
acceleration/deceleration control system, Fig. 7 shows 
input/output waveforms with respect to the system shown 
in Fig. 6, Fig. 8 is a block diagram of a first-order 
digital filter, Fig, 9 ' is a block diagram of a 

35 second-order digital filter, Fig. 10 is a block diagram 
of a third-order digital filter, and Fig. 11 is a flow 
chart for explaining an operation of the present 
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invention when the third-order digital filter is 
coupled to the linear acceleration/deceleration control 
section. 

Best Mode of Carrying Out the Invention 
5 The present invention will be described in detail 

hereinafter. 

Transfer functions H(S) of a higher-order low pass 
filter can be obtained by a second-order transfer 
function, a third-order transfer function as a 
10 combination of first- and second-order transfer 

functions, and a fourth-order transfer function as a 
combination of second-order transfer functions in the 
following manner: 

2nd-order H(S) - (A 1 W Q ) 2 /{S 2 + (A^/Q^S 
15 + (A^) 2 } . (2) 

3rd-order H(S) = {(B^J/tS + B 1 W Q )} 

x [(A 1 W 0 ) 2 /{S 2 + (A 1 W Q /Q 1 )S 
+ (A^) 2 }] ...(3) 
4th-order H(S) « [(A 1 W Q ) 2 /{S 2 + (A^/Q^S 
20 + (A^) 2 }] x [(A 2 W Q ) 2 /{S 2 

+ (A 2 W Q /Q 2 )S + (A 2 W 0 ) 2 }]...(4) 
where A^ f A 2 , B^ , and Q 2 are coefficients and W Q is 
the angular velocity at a cutoff frequency of the 
filter. 

25 By properly selecting the coefficients (i.e., A 1 , 

and of the transfer functions H(S), a low-pass 

filter having a high speed and smooth response and free 
from vibrations can be obtained. This low-pass filter 
may be any one of Bessel, Butterworth and Chebyshev 

30 filters. 

An optimal low-pass filter for achieving the above 
objects of the present invention can be obtained such 
that the coefficients of the Bessel filter are properly 
selected , and a cutoff frequency of the filter is 
35 selected to cut off the natural frequencies of the 

servo control system and the load system. This Bessel 
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low-pass filter is used as the acceleration/decelera- 
tion control section 1 in Fig. 1. An output shown in 
Fig, 3(b) is generated from the acceleration/decelera- 
tion section 1 in response to the input waveform of the 
5 position instruction, as shown in Fig. 3(a). In this 
manner, the high-frequency component is cut off from 
the position instruction, so that a change in output V^^ 
is smooth. A high acceleration speed at the leading 
edge of the output will not be obtained. As a result, 

10 the time required for decelerating and stopping the 
servo motor can be shortened. 

As a second embodiment of the present invention, 
a high-order low-pass filter 4 is connected to an 
output of a linear acceleration/deceleration section 3, 

15 as shown in Fig. 4. An output from the low-pass filter 
4 drives a servo control section 6 and a servo motor M. 
This output V 2 becomes smooth, as shown in Fig. 5(c). 
More particularly, when a pulsed input V Q shown in 
Fig. 5(a) is supplied to the linear acceleration/de- 

20 celeration section 3, the linear acceleration/decelera- 
tion section 3 generates an output V,^ , as shown in 
Fig. 5(a). In the conventional control system, the 
output V 1 is supplied to the servo control section 6. 
However, according to the present invention, the output 

25 V 1 is supplied to the high-order low-pass filter 4 

which then generates the output V 2 whose waveform is 
illustrated in Fig. 5(c). The output V 2 is then 
supplied to the servo control section 6. As a result, 
since the output V 2 whose waveform shown in Fig. 5(c) 

30 is smoother than that of the output V x shown in 

Fig. 5(b) is supplied to the servo control section 6, 
the servo control section 6 and the servo motor M will 
not receive shock caused by an abrupt change in 
velocity and will not generate vibrations. In 

35 addition, the servo control section 6 and the servo 
motor M have a fast response time. 
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As described above, the low-pass filter is used in 
the acceleration/deceleration control section according 
to the present invention. In the linear accelera- 
tion/deceleration system, the linear acceleration/de- 
5 celeration section 3 and the low-pass filter 4 

constitute an acceleration/deceleration control section 
5. As a result, an acceleration/deceleration control 
system having a fast response time and being free of 
vibrations can be obtained* 

10 An embodiment of the present invention which has 

the acceleration/deceleration control section 5 
consisting of the linear acceleration/deceleration 
section 3 and the low-pass filter 4 will be described 
with reference to the accompanying drawings. 

15 Digital processing of the linear acceleration/de- 

celeration section 3 will be described with reference 
to Fig. 6. A position instruction Pa for each axis is 
supplied from an interpolation distribution control 
section or the like to the linear acceleration/decel- 

20 eration section 3 for each sampling (a sampling period 
T) . The linear acceleration/acceleration section 3 has 
(n - 1) delay units Z~* (delay of the sampling period 
T) (where n is a value obtained by dividing by the 
sampling period T an acceleration/deceleration time 

25 from the beginning to the end of acceleration or 

deceleration, i.e. , n = t/T) . The position instruction 
Pa is added by an adding means 10 to the output from 
each of the delay units Z~* , A multiplying means 11 
multiplies 1/n with a sum from the adding means 10, 

30 thus obtaining Pb as follows: 

Pb = (Pa + X x 4- X 2 + . . . + X n-1 )/n ...(5) 
For example, if the position instruction Pa, the 
sampling period T and the acceleration/deceleration 
time are given as 100 , 8 , msec and 40 msec f 

35 respectively, n * 40/8 - 5. The linear accelera- 
tion/deceleration section 3 comprises four delay units 
Z * , and the relationship between the input and the 
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output is shown in Figs, 7(a) and 7(b). In the first 
sampling cycle, 

Pa » 100, and X 1 to X 4 = 0, 
therefore, 

5 Pb = (Pa + X x + X 2 + X 3 + X 4 )/n 

« 100/5 » 20 
In the second sampling cycle, 
Pa = 100, X 1 = 100 and X 2 to X 4 = 0 
therefore, 
10 Pb « (100 + 100)/5 = 40 

Similarly, in the third sampling cycle, Pb = 60 is 
obtained; in the fourth sampling cycle, Pb = 80; in the 
fifth sampling cycle, Pb - 100. In this manner, Pb is 
linearly increased. When the input Pa becomes zero, as 
15 shown in Fig. 7(a), the output Pb is also linearly 
decreased. 

The linear acceleration/deceleration section 3 is 
operated as follows. 

The high-order digital low-pass filter 4 will be 
20 described. This filter 4 can be prepared by a 

combination of the first- and/or second-order elements. 
The transfer function of the first-order filter is 
given by equations (1) and (3) in the following manner: 

H(S) - BW Q /(S + BW Q ) 
25 This transfer function is Z-transf ormed to obtain a 
pulse transfer function as follows: 

H(Z) - G/(l - K-Z" 1 ) 
This pulse transfer function is achieved by the circuit 
shown in Fig. 8. 
30 Referring to Fig. 8, reference numeral 12 denotes 

a multiplying means; and 13, an adding means. 
Reference symbol Z*" 1 denotes a delay unit for delaying 
an input by one sampling period T. Reference symbols K 


and G are values given as follows: 
35 K - e- BW 0 T 

G = 1 - K 


- 9 - 


01 39010 


where B is the filter coefficient and W Q is the angular 
velocity at the cutoff frequency f Q of the filter, 


i-e. , W A = 2irf, 


When the operation of the circuit shown in Fig, 8 
5 is performed for every sampling period T, a first-order 
digital filter can be obtained* In other words, the 
operations are performed as follows to obtain Y Q : 

Y l ~ Y 0 <Y 1 is the immediatel Y preceding sampled 
value of a sampled value Yq) 
10 Y Q - G-X + K-Y 1 

The sample value Y Q from the first-order filter is an 
output therefrom. 

Similarly, a Z-transf ormed pulse transfer function 
of the second-order transfer function H given by 
15 equation (2) is derived as follows: 
H(Z) * G/U - K-Z" 1 - L*Z~ 2 ) 
This transfer function is achieved by a circuit shown 
in Fig. 9. The following operations are performed for 
every sampling period T so as to obtain an output Yq , 
20 thereby obtaining a second-order digital filter. 

Y 0 ~ Y- (Y 7 is the immediately preceding sampled 

value of the sampled value 
Y l ~ Y 0 (Y 1 is the inunediate1 ^ Preceding sampled 
value of the sampled value Y Q ) 
25 Y Q = G-X + K-Y x + L-Y 2 

for K - 2*e~ AW 0 T/2Q *cos(AW Q Tj4? - 1/2Q) 
L - -e~ AW 0 T/Q 
G = 1 — K - L 

3 0 when the circuits shown in Figs. 8 and 9 are 

connected in series in consideration of the orders of 
the filters, the third- and fourth-order digital 
low-pass filters given by equations (3) and (4) can be 
obtained. Additional filters shown in Figs. 8 or 9 are 

35 selectively connected to obtain a higher order digital 
low-pass filter. 

For example, in order to obtain a third-order 


filter, an output from the circuit shown in Fig* 8 is 
supplied to the circuit shown in Fig. 9. In other 
words, the first- and second-order filter operations 
are successively performed as follows: 

y i - Y o 

Y Q - Gl .X * ^•Y 1 

z 2 = Zl 
z i - z o 

Z Q - G2.Y Q + K 2 - Zl + L 2 -Z 2 

The output Z Q is thus obtained from the third-order 
digital filter. 

The standard values of the respective coefficients 
Q, A and B in the Bessel filter are given below: 

For the second-order filter: 

Q = 0.5774 and A « 1.732 

For the third-order filter: 

Q = 0.6911, A - 2.542 and B = 2.322 

For the fourth-order filter: 

Q 1 « 0.5219, A x = 3.023, Q 2 « 0.8055 and A 2 

- 3.389 

When the values of the coefficients Q, A and B 
(especially the value of coefficient Q) are changed, a 
filter which does not overshoot in response to the step 
input can be obtained. 

Another embodiment will be described wherein the 
low-pass filter 4 is coupled to the output of the 
linear acceleration/deceleration section 3 shown in 
Fig. 4. The linear acceleration/deceleration control 
shown in Fig. 6 is performed, and a resultant output is 
processed by the three-order low-pass filter shown in 
Fig. 10 under the control of a microprocessor or the 
like. This operation will be described with reference 
to a flow chart shown in Fig. 11. 

The coefficients Q, A and B of the Bessel 
third-order filter, the cutoff frequency f Q of this 
filter, the sampling period T and the time interval 
for which acceleration/deceleration is started and 
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continues until a preset value is obtained are preset 
to obtain the respective coefficients G 1 , K 2 , L 2 , 

G 2 and n (- x/T) * The obtained values are entered in a 
microprocessor for controlling a robot or a machine 
tool (the respective coefficients K x , G 1 , K 2 , L 2 and G 2 
may be calculated by the microprocessor) . The 
processing shown in Fig. 11 is performed for every 
sampling period T. 

When the position instruction Pa for each axis 
which is calculated by an interpolating means is 
supplied to the linear acceleration/deceleration 
section 3 for every sampling period T, the operation 
shown in Fig. 6 and given by equation (5) is performed. 
More specifically, the input value Pa and each of the 
delayed values X 1 to X n _ 1 stored in the memory are 
added. The resultant sum is divided by n. The 
obtained value Pb is then stored in the memory (step 
101) . At the same time, the memory contents for the 
values X x to X n-1 are shifted (steps 102-1 to 102-N-2) 
in such a manner that the value of X n _ 2 is stored in a 
memory area for x - (step 102-1), the value of X , is 
stored m a memory area for X n _ 2 {step 102-2),... the 
value of X 1 is stored in a memory area for X 2 (step 
102-N-2) , and the input Pa is stored in a memory area 
for X 1 (step 103) . This processing is the linear 
acceleration/deceleration processing F^. 

The third-order low-pass filter processing F 2 is 
then performed. Stored data from the memory area for 
Y Q is shifted to the memory area for Y^ (step 104) . By 
using the value Pb obtained by the linear 
acceleration/deceleration processing F and the value 
Y^, the following operation is performed: 

Y o - g x Pb + k 1 y i 

The resultant vlaue of Y Q is stored in the memory (step 
105) . The values stored in the memory areas for Z 2 and 
Z 1 are updated to the values stored in the memory areas 
for Z 1 and 2 Q (steps 106 and 107). The following step 
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is executed, and the resultant value of Z Q is stored 
(step 108) . 

Z 0 = G 2 Y 0 + K 2 Z l + L 2 Z 2 

The value stored in the memory area for Z Q is 
5 generated as Pc (step 109) . 

When the processing F 1 and the processing F 2 are 
executed for every timing period, the output Pb from 
the linear acceleration/deceleration section 3 in 
response to the input Pa is shown in Fig. 5 (b) , and the 

10 output Pc from the low-pass filter 4 is given as a 
smooth waveform signal, as shown in Fig. 5(c). The 
output Pc is supplied to the servo control section 6, 
high-speed acceleration/deceleration control can be 
performed without subjecting the servo control section 

15 6, the servo motor M and the like to shock. 

In the embodiment described with reference to the 
flow of Fig. 11, the processing F 2 of the low-pass 
filter is performed after the linear acceleration/de- 
celeration processing according to the acceleration/de- 

20 celeration system shown in Fig- 4. However, according 
to an acceleration/deceleration system having the 
acceleration/deceleration section consisting of only a 
low-pass filter, only the processing F 2 of Fig. 11 can 
be executed. In this case, Pb « Pa is established. 

25 According to the present invention as described 

above, the high-frequency component is cut off by the 
higher-order low-pass filter, and a fast response time 
can be obtained. Therefore, the servo control system 
and its load system will not be subjected to shock, and 

30 precise control can be performed. 


35 
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CLAIMS 

1. An acceleration/deceleration control system of 
a servo motor, characterized in that a position 
instruction is' filtered through a low-pass filter of 

5 second or higher order, thereby performing accelera- 
tion/ deceleration control of the servo motor. 

2. A system according to claim 1, characterized 
in that said low-pass filter comprises a Bessel filter. 

3. An acceleration/deceleration control system of 
10 a servo motor, characterized in that a position 

instruction is subjected to linear acceleration/decel- 
eration control and thereafter is filtered through a 
low-pass filter of second or higher order. 

4. A system according to claim 3, wherein said 
15 low-pass filter comprises a Bessel filter. 


20 


25 


30 


35 
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